/***************************************
功能：实现小车前进，后退，左转，右转, 停止
接线：............................
                  车头
                 随动轮

             
      左轮-标签1        右轮-标签2

                  车尾
*****************************************/
#include "uni_motor.h" //调用编码电机库
#define RATE 115200    //定义串口波特率
UNI_MOTOR motor1(1, true);  //声明小车左轮
UNI_MOTOR motor2(2, true);  //声明小车右轮
float set_target_vel = 0.1; //设定轮子目标速度0.1m/s
/*枚举小车状态
  FORWARD:前进  BACK:后退  LEFT:左转  RIGHT:右转 STOP:停止*/
enum{FORWARD=1,BACK,LEFT,RIGHT,STOP};

void setup() {
  delay(1000);
  Serial.begin(115200);  //打开串口
  motor_init();//编码电机引脚初始化
}

void loop() {
  motor_move(FORWARD, 3000); //小车前进3000毫秒
  motor_move(BACK, 3000);    //小车后退3000毫秒
  motor_move(LEFT, 3000);    //小车左转3000毫秒
  motor_move(RIGHT, 3000);   //小车右转3000毫秒
  motor_move(STOP, 3000);    //小车停止3000毫秒


  /* 控制小车前进方式2
  car_forward(); //小车前进
  motor_update();//更新小车状态
  */
}
